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Abstract 



The method involves acquiring sensor signals using two complementary methods which exploit available 
measurement data and accuracy respectively. The measurement signals of the movements of an object (1 ) 
of a first sensor (2) are used in a simulation (5) and appropriate data are acquired. The movement data are 
fed into a simulation (6) of the second measurement method for generating simulated measurement signals 
of the second sensor arrangement (3). The simulated signals are compared with the actual measurement 
signals from the second sensor arrangement. The movement simulation is corrected according to the 
comparison results and its output signals used as navigation method output data. 
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Zur einander erganzenden Auswertung von Daten unter- 
schiedlicher Mefcmethoden zum Zwecke der Navigation fur 
einen bewegbaren Gegenstand wird ein Verfahren angege- 
ben, bei dem 

- mit einer ersten Mefcmethode hinsichtlich der Verfugbar- 
keit vorteiihafte MeBsignale einer ersten Sensoranordnung 
(2) und mit einer zweiten Me&methode hinsichtlich der 
Genauigke'rt vorteiihafte MeBsignale einer zweiten Sensor- 
anordnung (3) gewonnen werden, 

- die MeBsignale (u) der ersten Sensoranordnung auf eine 
Simulation (5) der Bewegung des Gegenstandes angewen- 

det und hieraus Bewegungsdaten (*) ermittelt werden, 

- die ermittelten Bewegungsdaten in eine Simulation (6) 
der zweiten MeBmethode zur Erzeugung simuiierter MeBsi- 

gnale ^ der zweiten Sensoranordnung (3) eingegeben 
werden, 

- die simulierten Me&signale ( y > mit tatsachlichen MeBsi- 
gnalen (y) der zweiten Sensoranordnung (3) verglichen 
werden, 

- aus dem Vergleich die zugrunde gelegte Simulation (5) der 
Bewegung des Gegenstandes korrigiert wird und 

- die durch die Simulation (5) der Bewegung des Gegenstan- 
des (1) ermittelten Bewegungsdaten als Ausgangsdaten (E) 
des Navigationsverfahrens ausgegeben werden. 
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Beschreibung 

Die Erfindung betrifft ein Verfahren zur Navigation mit einander erganzenden Auswertungen von Daten 
unterschiedlicher MeBmethoden fGr einen bewegbaren Gegenstand wobei mit einer ersten MeBmethode hin- 
stchtlich der VerfQgbarkeit vorteilhafte MeBsignale einer ersten Sensoranordnung und mit einer zweiten MeB- 
methode hinsichtlich der Genauigkeit vorteilhafte MeBsignale einer zweiten Sensoranordnung verarbeitet 
werden. 

Es ist bekannt, Daten verschiedener Sensoranordnungen fur die Navigation zu verwenden, wobei regelmaBig 
die Daten tier einen Sensoranordnung, beispielsweise durch ein bordeigenes autarkes System, standig zur 
VerfQgung stehen, wahrend Daten einer zweiten Sensoranordnung, die eine Bestnnmung von Bewegungsdaten, 
einschlieBtich Ortsdaten, mit einer hdheren Genauigkeit erlauben, von externen Obermittlungen abhangig sind 
und daher aufgrund von Stdrungen, Abschattungen usw. nicht standig zur VerfQgung stehen. Die Daten der 
zweiten Sensoranordnung werden zur Stutzung der Daten der ersten Sensoranordnung herangezogen, urn 
deren Genauigkeit zu erhdhen. 

Gangige autarke Sensoren sind insbesondere Inertialsensoren, aber auch beispielsweise Radsensoren. Als 
Stutzsysteme kommen insbesondere die Satellites und Funknavigation in Frage, deren Sensoren somit Anten- 
nen aufweisen. 

Bei den bekannten Navigationsverf ahren dieser Art werden aus den MeBdaten der ersten Sensoranordnung 
beispielsweise mit Hilfe einer ^trap-Down-Rechnung* Bewegungsdaten ermhtelt Ausgangspunkt fur die Aus- 
wertung ist, daB die aufgrund der MeBdaten der ersten Sensoranordnung ermittelten Bewegungsdaten fehlerbe- 
haftet sind Es wird daher ein linearisiertes Fehlermodell zur Errechnung einer Korrektur zugrunde gelegt 
Durch die Anwendung der zweiten MeBmethode als Stutzsystem, insbesondere einer SatelKtennavigationsme- 
thode, werden die f ehlerbehafteten Bewegungsdaten gemaB der ersten MeBmethode mit Ausgangsdaten der 
zweiten MeBmethode verglichen und hieraus ein Fehlerwert gebildet Zur Anpassung des Knearisierten Fehler- 
modells an die aktuellen Werte wird der im Knearisierten Fehlermodell vorhergesagte Fehler mit einem Kneari- 
sierten Stfitzmodell so umgewandeh, daB ein prognostizierter Fehlerwert entsteht, der mit dem durch Vergleich 
der beiden MeBmethoden ermittelten Fehlerwert vergKchen wird Ober einen Regler, der beispielsweise nach 
dem Kalman-Filter-Prinzip ausgelegt ist, wird mit dem f es tgestellten Vergleichswert das linearisierte Fehlermo- 
dell einerseits, die eigentKche Strap-Down-Rechnung andererseits korrigiert Da die fehlerbehafteten, durch die 
Strap-Down-Rechnung ermittelten Bewegungsdaten fur die Bestimmung des Arbeitspunktes sowohl auf das 
linearisierte Fehlermodell und das linearisierte StOtzmodell als auch auf den Regler gelangen, entsteht eine 
vielf ache Wechselwirkung zwischen der Strap-Down-Rechnung einerseits und dem Regelkreis zur Anpassung 
des Knearisierten Fehlermodells und des Knearisierten StQtzmodells andererseits. Diese externe Korrektur des 
Kalman-FQters ist fur diesen eigentiich systemfremd und bewirkt gegebenenfalls instabile Verhaltensweisen des 
Regelkreises und damit des Navigationsverf ahrens. 

Es sind Navigationssysteme fur Kraftfahrzeuge bekannt, bei denen eine ubKche Standortbestimmung mit 
bordeigenen Sensoren und ggf. einem Sateiliten-Navigationsempfanger erfolgt Ober einen Umschalter konnen 
diese aus DE 44 28 009 Al, EP 0 519 593 A2 oder JP 07 31 1 043 A (Patent Abstracts of Japan) bekannten Systeme 
in eine Simulations-Betriebsart gebracht werden, in der eine Fahrt vom aktuellen Ausgangspunkt zu einem 
gewahlten Endpunkt simuKert und mit Hilfe einer Karte dargesteDt wird Die Simulations-Betriebsart beeinfluBt 
die eigentKche Standortbestimmung nicht 

Der vorKegenden Erfindung Kegt daher die ProblemsteUung zugrunde, das Navigationsverf ahren der ein- 
gangs erwahnten Art so auszubilden, daB eine Verbesserung des Regelsystems erreicht wird und mdgliche 
InstabiKtaten, die aufgrund der bisherigen Ausbildung des Regelsystems mogKch sind, vermieden werden kon- 
nen. 

Ausgehend von dieser ProblemsteUung wird erfindungsgemaB ein Verfahren zur Navigation mit einander 
erganzenden Auswertungen von Daten unterschiedlicher MeBmethoden fur einen bewegbaren Gegenstand 
angegeben, bei dem 

— mit einer ersten MeBmethode hinsichtlich der Verfugbarkeit vorteilhafte MeBsignale einer ersten Sen- 
soranordnung und mh einer zweiten MeBmethode hinsichtlich der Genauigkeit vorteilhafte MeBsignale 
einer zweiten Sensoranordnung gewonnen werden, 

— die MeBsignale der ersten Sensoranordnung auf eine Simulation der Bewegung des Gegenstandes 
angewendet und hieraus Bewegungsdaten ennittelt werden, 

— die ermittelten Bewegungsdaten in eine Simulation der zweiten MeBmethode zur Erzeugung simuKerter 
MeBsignale der zweiten Sensoranordnung eingegeben werden, 

— die simulierten MeBsignale mh tatsachlichen MeBsignalen der zweiten Sensoranordnung vergKchen 
werden, 

— aus dem Vergleich die zugrunde gelegte Simulation der Bewegung des Gegenstandes korrigiert wird und 

— die durch die Simulation der Bewegung des Gegenstandes ermittelten Bewegungsdaten als Ausgangsda- 
ten des Navigationsverf ahrens ausgegeben werden. 

Kern der Erfindung ist, daB die gesamte Gegenstandsbewegung in einem BewegungsmodeK rechnerisch 
simuliert wird urn dadurch die benotigten Bewegungsdaten, gegebenenfalls einschlieBKch etwaiger HQfsdaten, 
zu schatzen. Die geschatzten Bewegungsdaten dienen ais Ergebnis des Verfahrens zur Navigation. Da die 
ursprungKch geschatzten Bewegungsdaten stark fehlerbehaftet sind gelangen sie auf ein Modell des Stutzsy- 
stems, in dem die Bewegungsdaten zu simuKerten MeBdaten des Stutzsystems transformiert werden. Diese 
werden in einer Vergleichsstufe mit den realen MeBdaten des Stutzsystems vergKchen. Mit dem Ergebnis des 
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Vcrglcichs wird ein Regler gesteuert, der seinerseits das komplette BewegungsmodeU verandert, urn so zu 
besser geschatzten Bewegungsdaten zu gelangen. 

Im Unterschied zum Stand der Technik findet die Auswertung der MeBsignale der ersten Sensoranordnung 
ausschlieBlich in einem simulierten BewegungsmodeU statt, das in seiner Gesamthek durch den Regler verander- 
bar ist Bei der Ausbfldung des Bewegungsmodells innerhalb eines Kalman-Fflters findet somh die Korrektur 5 
dutch die Regdung des Kalman-Fikers statt und nicht - wie bisher - zumindest teilweise auBerhaib des 
Kalman-Fflters. Daher lafit sic* der erfindungsgemaB vorgesehene RegeDcreis stabiler aufbauen, wefl InstaKlita- 
ten aufgrund externer Korrekturen der Strap-Down-Rechnung, beispielsweise mit Hilf e eines Kalman-FUters, 

VC Dte ^^dmSg^emaBe komplette Simulation der Bewegung als auch des StQtzmodeUs ermdglicht insbesonde- 10 
re auch die Anordnung der Sensoranordnungen fur die beiden MeBmethoden mit einem Abstand voneinander, 
der rechnerisch nicht mit Null angenommen werden muB, sondern in der Simulation der zweiten MeBmethode 
(des Stfltzsystems)berQcksichtigt wird t 

Die Erfindungwirdim folgenden anhand von zeichnenschen Darstellungen naher erlautert Es zeigen: 

Fig. 1 ein Blockschaltbild zur schematischen Darstellung des erfindongsgemaUen Verf ahrens, 

Fig. 2 ein Blockschaltbild fur ein AusfOhrungsbeispiel eines Bewegungsmodells aus Fig. 1. 

Fig. 1 ist durch eine horizontale gestrichdte Unie in einen Bereich 'Wirkfichkeit* und einen Bereich "Simula- 
tion 9 unterteilt j 

Als bewegter Gegenstand ist in Fig. 1 ein Fahrzeug 1 angenommen, dessen (sich andernde) Bewegungsdaten 
ein Teil von x sind Das Fahrzeug 1 ist mit einer ersten Sensoranordnung 2 und einer zweiten Sensoranordnung 3 
versehen, wobei die erste Sensoranordnung 2 ein Inertialsensorsystem und die zwdte Sensoranordnung 3 ein 
Antennensystem fOr einen Satellitennavigationsempf anger sein kann. Die durch die zwehe Sensoranordnung 3 
empfangenen Daten, insbesondere SateUitendaten, werden mit einem zum Satellitenempfanger gehorenden 
Auswertungssystem 4 als Sttttzsystem ausgewertet und dadurch StQtzdaten y gebildet Ublicherweise sind die 
StQtzdaten y Schragentf ernungen zu verschiedenen Satellites 

Die erste Sensoranordnung 2 liefert Ausgangsdaten u, die auf ein mathematisches BewegungsmodeU 5 
gelangen. Am Ausgang des Bewegungsmodells 5 stehen geschatzte Daten S, Bewegungsdaten mit Hilfsdaten, die 
auf ein StGtzmodell 6 als simuliertes Stutzsystem geleitet werden. Durch das Stfltzmodefl 6 werden die geschatz- 
ten Daten * in geschatzte Stfitzdaten ? transformiert Die geschatzten Daten f werden mit den gemessenen 
Daten y in einer Diff erenzstuf e 7 verglichen. Das Ausgangssignal gelangt auf einen Regler 8, der in Abhangigkeit 30 
vom Eingangssignal das BewegungsmodeU 5 ansteuert, am so zu besseren Schatzungen far die Daten fc zu 
gelangen. Am Ausgang des Bewegungsmodells 5 stehen auch die durch das Verfahren ermittelten Ergebnisdaten 
E an, die somh ausschlieBlich im simulierten Tefl des Navigationsgerats gebildet werden. 

Die Aufgabe des Bewegungsmodells 5 besteht in der Nachbfldung der Fahrzeug-/Sensorbewegung sowie ggf. 
von Sensoreigenschaften. Dabei kdnnen vektorielle oder skalare GroBen wie Position, Geschwindigkeit, Be- 35 
schleunigung, Lage, Drehrate, Sensorf ehler usw., berucksichtigt werden. Als mathematische Basis dienen ge- 
wohnliche Differentialgieichungen, die aus verschiedenen Gebieteri stammen, wie beispielsweise Strap-Down- 
Technologic Koppelnavigation, SensorfehlermodeU usw. Mit HiKe des Bewegungsmodells 5 werden die Bewe- 
gungsdaten * geschatzt, fur die Beschleunigungs-, Geschwindigkeits- und Positionsvektoren, Schragentfernun- 
gen und deren zeitliche Anderungen, Entfernungsdifferenzen, Richtungen, Strecken oder Geschwindigkeiten 40 
entlang von Bahnen usw. verwendet werden konnen. 

Die Aufgabe des Reglers ist es, dafur zu sorgen, daB die geschatzten GroBen den Verlauf der tatsachlichen in 
angeraessener Weise nachbilden. Zur Auslegung des Reglers kdnnen beispielsweise die Theorien eines Kalman- 
Filters oder eines anderen Optimalfilters sowie eines Luenberger- oder nichtlinearen Beobachters verwendet 

werden. 45 
Die Aufgabe des Stutzmodelk 6 ist die Nachbfldung der StutzgrdBen sowie ggf. die ErfuUung mathematischer 

Nebenbedingungen. Anwendungsabhangig konnen Bewegungsdaten wie Beschleunigungs-, Geschwindigkeits- 

und Positionsvektoren, Drehgeschwindigkeits- und Drehvektoren, Schragentf ernungen und deren zeitliche 

Anderungen, Entfernungsdifferenzen, Richtungen, Strecken oder Geschwindigkeiten entlang von Bahnen usw. 

verwendet werden. Die mathematische Basis des Modells ist zweckmaBigerweise ein Satz von Gleichungen. 50 
Auf den Regler gelangen die geschatzten Bewegungsdaten *. Hierdurch wird lediglich der Arbeitspunkt des 

Reglers 8 beeinfluBt, nicht aber die eigentliche Regelfunktion. 
Fig. 2 zeigt ein Ausfuhrangsbeispiel fur ein BewegungsmodeU 5 fur MeBsignale u eines InertialmeBsystems. 

Fur die Benennung von GroBen und Koordinatensystemen sind folgende Festlegungen gewahlt worden: 
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• GroBen * 

Vektoren 

- Kennzeichnung: Pfeil, z.B. r 

- Index: 1. Bezugssystem, 2. Darstellungs- 

system, z.B, r£ f8 

- Komponenten: Welter er Index z.B. 

~ [ r x,r,g f ...] 

Quaternionen 

- Buchstabe q, konj • komplex q 

- Komponenten 

q [q 0 (reell), q^, qa (imaginax) J 

Matrizen 

- Kleinbuchstaben: einspaltige Matrizen/ Vekto- 
ren ohne phys . Bedeutung 

- Grofibuchstaben: mehrspaltige Matrizen 
• Komponenten: Indizes, z.B. f x , F23/ 

* Koordinatensysteme 

Korperfest Index b, Komponenten x,y,z 

Erdlotfest 9# ac,y,z (N,E r D) 

BCEF* e, x,y,z 

Inertial i, x r y r z 

*Earth-Centered-Ear th-F ixed 



Das MeBsignal u beispieisweise eines InertiaimeBsystems gelangt auf inverse Sensonnodelle 10, 10 7 . Am 
Ausgang des Sensormodells 10 steht ein inertialer Beschleunigungsvektor a£ ixn korperf esten System. Dieser 

50 wird durch eine Matrix Ceb in das ECEF-System transformiert In einer folgenden Kompensationsstufe werden 
bei der Transformation entstehendg Scheinbeschleunigungen, wie Coriolis- und Zentrifugalbeschleunigungen, 
eliminiert. £s folgt eine Integration 13 zur Bildung des zugehorigen Geschwindigkeitsvektors und eine Integra* 
tion 14 zur Bildung des zugehorigen Ortsvektors. Die Ortsvektordaten und Geschwindigkeitsvektordaten 
gelangen als Teil der Bewegnngsdaten St zura StutzmodelL Fur die Ausgabe des Ergebnisses E wird noch eine 

55 Umrechnung 15 in ein erdlotfestes System vorgenommen. In ahnlicher Weise wird eine Transformation 16 des 
Geschwindigkeitsvektors fur die Ausgabe des Ergebnisses E durchgefuhrt 

Mit dem inversen Sensormodell 10' werden Drehgeschwindigkeiten gebildet, die in einer Integrationsstufe 17 
verarbeitet und in einer Umrechnungsstufe IS in ubliche Gierwinkel *F, Nickwinkel 9 und Rollwinkel <E> unter 
Verwendung der erdfesten Position vom Ausgang der Umrechnungsstufe 15 umgerechnet werden und ebenfalls 

60 ab Teil des Ergebnisses E ausgegeben werden. Die vor der Umrechnung vorliegenden Daten gelangen zum 
StutzmodelL Zu Ruckfuhrungszwecken sieht das Bewegungsmodell noch eine Transformationsstufe 19 vor, 
durch die ein Modell der Erdbeschleunigung auf die Kompensationsstufe 12 gelangt 

Fig, 2 verdeutlicht, daB der Regler 8 sowohl auf die Sensonnodelle 10, 10' als auch auf die Integratoren 8, 13, 14 
einwirkt, also auf alle Stufen des Bewegungsmodells 5, die der eigentlichen Modellierung der Bewegung dienen 

es und nicht nur einer Umrechnung in verschiedene Koordinatensysteme. 

Zur Erganzung der qualitativen Erlauterung des Bewegungsm dells gemaB Fig. 2 und des Verfahrens gemaB 
Fig. 1 werden nachstehend verwendete Algorithmen angegeben. 
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1. Lagewinkel-Rechnung 

(a) i. q beschreibt D reining vom e- ins b-System (direkt!) bzw. Drehung vom 
b- ins e-System, d.h. fur Drehgeschwindigkeit u : 1. Index "eb^, 
lant [7] gilt damit: 



qc6 = | £e6,e qrf nut = ^ - u ie 

1 - • 1 - 

qc6 = a ^ qeb + 2 

ii. Transformation [7]: z-B. 

f c>c = q*6 f Cf 5 qc6 
Hi. Komponenten: 





0 








0 















*?0 




ft 


1 


ft 


2 







-qi,e6^ T &,6 - <H^y % ih % b - q3,e&0*>x^6,6 - w r,te,e) 

q3 |€ *W Xr A,fr + qo f c6^y,^ - qi f e*(w*^> +^e^) 
-q2,e5^r,£6> + qi^^ir^.6 + qo^(^,»,6 - W^e,*) 



[qit* + q£e6 - q|,c6 - ql.e6 2^,^2*6 - qo^qa.c*) 
2(qi,e6q2,e6 + qo,e6q3,e6) qo,c& - q?^6 + q| t c5 qle6 
2(qi,e*q3,e& - qo.c6q2.e6> 2(q2,c6q3.e6 + qo,e*qi,e6) 

2(qi,e6q3,e6 + qO f e6q2 f e6) 
2(q 2l c6q3.e6 - qo.e6qi.e6) ^6 

^ - q?^ - ql,e6 + q|,e6) J 

(b) Es gilt fur die Transformationsmatrizen C: 

C cb = C C3 C gb 0^ = 0^0^ 

(C^ siehe Gleiclmng (34)) 

Aufierdem gilt mit [8] und dem Gierwinkel 0, dem Nickwinkel 0 
und dem Rollwinkel <f>: 



(24) 



(25) 



(26) 



(27) 



(28) 
(29) 



C gb = 



cos 5 cos ^ sin sin 0 cos ^ — cos <f> sin 0 cos ^ sin 6 cos ^ + sin <f> sin 1 
cos 6 sin ^ sin sin d sin 0 + cds^cos0 cos sin 0 sin 0 — sin <f> cos t 
— sin0 cos#sin<£ cosflcos^ 
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Hieraus folgt aus (29) 

8 = — arcsin C a ^i (auf Rundungsfehler achten) 

4> - arcsin (C^^/ cos (?) (auf 0 = ±90° achten, Quadrant aus C ski33 ) 

^ = arcsin {C ah ,n/ cos 0) (auf 6 = ±90° achten, Quadrant aus C flMl ) 



(30) 



2. Geschwindigkeits-, Positionsrechnung 

(a) Beziehungen zwischen dem inertialen mid den ECEF-System (bewegt, rotierend) 
mit den Orts-, Geschwindigkeits- und Beschleunigungsvektoren r, tT, a: 

n- = + r c 

*fc = % + v c +(Si e x r c 

*t = &ie +Ee +&U X f; + 2£{ t X V e + t3 ic X (u> tc X f c ) 

a c = a* - Of c - 2w t -e X v c x (w ie x r c ) (nut <3 1C x r c « 0) 
t^tc ist bekannt; (Si — 5t*c — g g ) folgt aus Messungen, ^ sei bekannt 



(b) i. Mit Si — Si c — g =: Sh folgt 

ae, e = V CwC = C^Sfc^ - 2£ ie . c x - w; CfC x (a> lc?c x f^) + C ej ^ 



n. tv c = 



111. 



(31) 
(32) 

(33) 



a x.6.6 



S.O. 



0 
0 



Einschub: C cy beschreibt die Transformation vom g-System in das e-System. 
Hierbei ist zunachst eine Drehung urn 90° + <p (<p: geograph. Breite) urn die 
y-Achse, dann eine Drehung nm — A (A: geograph* Lange) um die z-Achse 
auszufuhren. 



cos A — sin A 0 
sin A cos A 0 
0 0 1 



-sin(90°-fy) 0 
0 1 
cos(90° + <p) 0 

— sin <p cos A — sin A — cos \p cos A 

— sin y> sin A cos A — cos <p sin A 

cosy 0 — siny> 



- cos(90° + tp) 

0 

- sin(90° + <p) 



(34) 
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0 







Vy tCf C 









2 (qi,e*q2,ei + qo,«kq3.e*)a*A* 

2 (qi,e»q3.e» - qo.«kq2,e&)o*.s,» 



+2(qi^q2^6 - qo,eiq3,etW.6> 
+2 (q2^q3^ft + qo,e6qi,efr)«if» 

+2 (qi,e»q3^ + qo,e»q2,e»)**,M + 2w*^e,etv(+<«>2,ie,e r *.e.e)" 



+2(q2^*q3,«i - qo.e*qi,e&)«*,M ~ 2«x.ie.«»?r(+<^i (VS r yie , e 

+ Oil* - ~ lie* + q|,*) 0 *^ 



r 



-cosv^cosA^,^ l 

— cosv>sinA^ 2 ^ 

— sin <p9*t94 

*: Klammer-Tercn ist ggf. im g-Modell enthalten 

( C ) iT^ = C^^e,e = C^U^e 

(d) Gemafi [14] gilt fur <p und A: 
= (^ + A)cosv?cosA 



(35) 



1 y,Ci« 



= (R' E + h)cos<psm\ 
= ((l-6*)jBfe + A)«n¥> 



(36) 



(37) 



/l— e 2 sin 2 y 



mit it^ = 

(A grofie Halbaxise, e 2 = 1 - f£, B kleine Halbachse, / = 1 - f ) 
TJmgekehrt: 



A •= arctan 



unter Vorzeidienbeaclitung von r y|CtC und r XtCjC : 



tan^ = 



ggf. € = 1 mm zur Verrneidung von Singularitaten am Pol 



10 



15 



20 



25 



30 



35 



40 



45 



50 



55 



60 



65 



7 



DE 196 36 425 CI 

V> = arctan y> w mit i « 2 konvergiert sehr schnell 



= yj{rl^ + r* e>e + + tan 2 v»« - ^3° (*> 

^ cosv> / 

(a) ist gunstiger, vreil tanp sehon berechnet ist 



Vorsicht in Polnahe; for 90' - M < 45° sollte JRg = A yj ™ d 
dann gerechnet warden: 



V> = arccoty> w mit i « 2 konvergiert sehr schnell 
= r wV /l + co^PV-(l-€ 2 )4° 



(38) 



Auflerdem gilt mit 



tan? 

A(l-e») 



COS 



v = y i+ti^v : 



jR * r ~ (l-e*sin 2 *>) 3/2 
Jt^: Meridiaa-Krummungsradius -R^: Querkruminungsradius 



Einscnub: 



—il^ sin cos A — 22^ cos y> sin A cosy? cos A 





dip 




dX 




dh 



(39) 



-i^shnpsinA J?^ cos 97 cos A cos<psinA 
R'pcostp 0 siny> 

Mittels Matrizeninversion folgt bei \<p\ < 90* (wobei die Determinante obiger Funk- 
tionalinatrix den Wert (-R' N - R r E cos <p) hat): 



dtp 




dX 




dh 





- -~r- sin <p cos A 



sin A 



cos 9> cos A 



— ^-siny>sinA -^cos v> 
cos <^ sin A siny? 













(40) 











<r>2 


V»3 










A3 






hi 


^2 


A 3 . 







a 
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i 

3. Erdbeschleunigung 
Mil den Bezeichnungen und Zahlenwerten aus [4] gilt nach [18]: 

( 1 + ksau*<p 

-(1 + fcriaV) (1M + 4C1 _ e >) >• * 

3(1^ . * if) - a^ii (41) 

4. Uhrenmodell 20 
Uhrenfehler At, Abicitung At « Atp, weiBes Rauschen w 



1 — e 2 sin* 9* 



10 



15 



[£]-[?] 



(42) 



5.Sensor-ModeIle 



tt — tt * + ^ (im System verwendete Gleichung, Korrektur dues Offsets) 

tt » Jb(u*) (tatsachliche Kenn Un ie) 

=>Uo = Jfc(tt-)-u* 

Annahme sei ein Polynom mit Koeffizienten v>: <o 

^^u*(wo + ta l tt* + u^(tt*) 2 + i03(O 3 + -) . . ( 43 > 

Znsatz-Annahme tp^weiSes Rauschen mit Mjttelwert 0 

45 

StutzgrdBen 

1. Positions-, Geschwindigkeitsstutzung: (GPS-, INS-, MLS-, Kamerastutzung) Umrechnungen: q>, X, h in [r^e. 



6. MeBfunktionen 55 



r*,e,e INS-Position; Antennenposition r* (GPS, DME, . . . ): 
r yA e INS-Position; Antennenposition r* (GPS, DME, . . . ): 
r^cfi INS-Position; Antennenposition r* (GPS, DME, . . . ): 
Vx^e INS-Position; Antennenposition r* (GPS, DME, . . . ): 
v y ,c^ INS-Position; Antennenposition r* (GPS, DME, . . . ) 
Vz[<*e INS-Position; Antennenposition r* (GPS, DME, . . . ): 



Gin. (48) (44) 
Gin. (48) (44) 
Gin. (48) (44) 

Gin. (48) (44) 60 

Gln.(48)(44) 

Gln.(48)(44) 



2. Range-, Range-Rate-Stutzung: (GPS-, DME-, LORAN^ Lasertracker-Stutzung) 

Pro Satellit/Bodenstation gilt mit der Satellitenposition r % o 65 
Satellitenuhrenfehler At s 

MeBfunktion Range 



DE 196 36 425 CI 

rgL Gleichungen (48X 

>bei At* a us den Enhemeriden hekannt ist 



CI 

+ c(A* — At,) (45) 



5 vergL Gleichungen (48X 

wobei At$ aus den Ephemeriden bekannt ist 
und At > ObedeutetrEmpfangeruhrgeht von 
FfirLasertrackergilt At m 0,At$ = 0. 

io MeBfunktion Range-Rate 

V = & = c(a\ - At,) ~ f ^Ke, " ^,e) (46) 

15 +(^ f e.e-r w )(w; AC -V yfJ ,e) 

+ O^e - - V w )) + C • At 

20 vergL Gleichungen (48), (49) (Addition der mit Richtungscosinus gewichteten Komponenten der Relativge- 
schwindigkeit Satellit-Empfangerantenne) 

Mefifunktion Range-Diff erenz 



25 



30 



= \/(^c " r w ) 2 + (r-^ - W )* + (r-^ - r w ) 2 (47) 
- y/(n^c - + (r^ - w)2 + (r^ - r w )» 



Mit Diff erenzvektor INS-GPS-Antenne: rjb = [rx^b. ry^jb, r^duJ 1 ^ gflt 



= re.e + C e 6 rk^ (48) 



+ 2(qi fC 6q2 t cfr — qo,e6q3 9 et) r y jj> 

+ 2(qt,4=6q3,e6 + qo t e6q2,e6) r z jfi 
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r y.e.e = r y.«.* + 2(qi t c6q2,e6 + qo.c6q3.e6) r x ^b 

+ 2(q2, c 6q3^ - qo.eiqi.c6) ^,6 
= r w + 2(qi,e6q3 f c6 - qo.e5q2.e6) 

+ 2(q2.e6q3,e6 + qo.e6qi.e6) ^y,rf,& 

+ COO.** - qi,e* " <lLe6 + q3.e6) T^b 

t£e = «eve + £«6 fC X = V^c - «*e.e X C^f^ + C^^^ X f^) 

mit 





















r *,4J> 



















= v x f e,e + (qo^6 + q?,e6 " ^Lft " ^l.e*) v x,djb 
+ 2(qi l e6q 2 .ed - q0.e6q3^) «VA* 
, + 2(qi fC 6q 3 ^6 + qo.-6Q2.c6) Vz.rf,6 
+ Wr.tc,e ( 2 (qi ;e 6q2^6 + q0.c6q3,c6) 

+(qo.e6 - q?.e6 + q2,e6 - q|.c6) r V 4* 

+ 2(q2.c6q3.e6 - q0.c6qi.c6) r*/£^) 
v y*,* = t; y,e,c"H2(q ltC tq2,e6 + qo.e6q3.c6)^,<£,6 (c) 

+(qo^6 - qU + q|.e6 - q!,e6) V VA* 

+ 2(q 2fC 6q3,c6 - qo.e6qi.e6) t>*4Jb 

-<*>*,icc ( (qo,c6 + qL6 - q2.c6 - q|,e6) r ^6 

+2(qi #e 6q 2t <.6 - qo.e6q3.c6) r y ^b 
+2(qi,e6q3,e6 -r qo,e6q2.c6) r^,^ 

<e,e = *W + 2(q l|C 6q3,e6 - qo.e6q2,c6) t>x,c\6 (d) 
+2(q2 fC 6q3^6 + qo,e6qi t c6) *W.6 

+(qo.c6 - qi,e6 - qie6 + qf,^) ^6 

3. H6henstutzung 

MeBfunktion: Iteration geraaB Gleichungen (38) 

4. Lagestutzung 

GPS: Positionsdifferenz mehrerer Antennen darzustellen ira ECEF-System: 
CebrJb-^Esgelten die Gleichungen (48) mit r^ce = T fAe = r w = 0 
INS, Magnetfeldsonde usw. 

EsgiltrCgb = Cge • Ccb 
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Es gilt: C ab = C JC • Crf 

=>sia0 = COS^c^ACqg^ + qf^-ql^-ql^) (a) (50) 

5 + cos v sin A (q1.ejq2.ei + q0.esq3.ek) * 2 

+ sin <p (qi<e4q3.« J - q0.eiq2.ei) • 2 

10 sintf = / 1 . 2a (-anA(qg >gt + qf tCt -q| >e& -q| tet y (b) 

+ cos A (q^qz^i + qo,eiq3^i) • 2) 



15 



20 



sinp = 7 1 , f — cosy cos A (q 1 ^ 4 q 2 ^ - qo.eiq3.ei) • 2 (c) 

- cosv»sin A (qg iet - qf^ + qf^ - q^^) 

— sin y (q2.eiq3.ei -I- qo.eiqi.ei) * 2) 



25 5. Radsensorstutzung 



30 



+ + (51) 



Eine Stutzung der Strecke ist nur eine "Verkappte" Geschwindigkeitsstutzung oder — bei bekannter Bahn 
eine Positionsstutzung. 

6. Winkelstfitzung 

35 

Elevationswinkel:(ILS, Lasertracker) 
cose =sia€=: — 

mit f* = — f C|C -4- *re/,e und I = [— cos v> cos A, — cos <p sin A, — sln<p] T git: 

A - cos <p cos A -f i? • cos u> sin A + C - sin v> , ^ 

4 5 sine = 7======== 21 (52) 

( ^ = r *.e,e — Tx m ref<e B = r y? ^ — r Vt ref w e C = r XtC>e — T z ^f^ ) 

50 Entsprechend gilt fur den Azimut gegen die Nordrichtung (VOR, Lasertracker) 

cos a =Nbrdkomponente von p[ 

sin a: — Os t komp onente von 

=Nord- und Ostkomponente von — f* 



55 



Aus C ge (f CiC - r rc/fC ) folgt: 

60 A* sin A + 5 -cos A 

tan a = - — ; x t p — : r— r — 7; (53) 

A • sin tp cos A + B • sin v> sin A — C - cos <p v ' 

( A = *r >e>e — r Xfre / fC 5 = r y r e,e ~~ r y,rc/ t e C = r^ c>c — T ZtTC j^ ) 



55 



Insbesondere Gleichung 48 verdeutlicht den rechnerisch beriicksichtigten Abstand zwischen dem Inertialsen- 
sorsystem (INS) und der Satellitenantenne (GPS), der bei einem Verkehrsflugzeug durchaus mehr als 30 m 
betragen kann. Wahrend bisher versucht worden ist, beide Sensoren mdglichst am selben Ort anzuordnen, urn 
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einen Abstand zwischen den beiden Sens ren vernachlassigen zu kfinnen, ist es eine erfindungsgemaBe Erkennt- 
nis, daB der Abstand so groQ wie mdglich gewahlt werden sollte, da hierdurch die Beobachtbarkeh verbessert 
und das Auftreten von Singularitaten sicherer unterdruckt wird. 

Patentanspruche 5 

1. Verfahren zur Navigation mit einander erganzenden Auswertungen von Daten unterschiedlicher MeB- 
methoden fur einen bewegbaren Gegenstand (IX wobei 

— mit einer ersten MeBmethode hinsichtlich der VerfQgbarkek vorteilhafte MeBsignale einer ersten 
Sensoranordnung (2) und mit einer zweiten MeBmethode hinsichtlich der Genauigkeit vorteilhafte to 
MeBsignale einer zweiten Sensoranordnung (3) gewonnen werden, 

— die MeBsignale (U) des ersten Sensors auf eine Simulation (5) der Bewegung des Gegenstandes 
angewendet und hieraus Bewegungsdaten (*) ermhtelt werden, 

— die ermittelten Bewegungsdaten (i) in eine Simulation (6) der zweiten MeBmethode zur Erzeugung 
simulierter MeBsignale ($) der zweiten Sensoranordnung (3) eingegeben werden, 15 

— die simulierten MeBsignale ($) mit tatsachlichen MeBsignalen (y) der zweiten Sensoranordnung (3) 
verglichen werden, 

— aus dem Vergleich die zugrunde gelegte Simulation (5) der Bewegung des Gegenstandes korrigiert 
wird und 

— die church die Simulation (5) der Bewegung des Gegenstandes (1) ermittelten Bewegungsdaten als 20 
Ausgangsdaten (E) des Navigatk>nsverfahrens ausgegeben werden. 

2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, daB die Sensoranordnungen (2, 3) fur die beiden 
MeBmethoden mh Abstand voneinander angeordnet werden und daB der Abstand fur die Simulation (€) der 
zweiten MeBmethode beriicksichtigt wird. 

- — ; — , 25 

Hierzu 2 Seite(n) Zeichnungen 
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